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Abstract  -  Borrowing  a  concept  from  hydrodynamic  analysis,  this  paper  presents  stream  functions 
which  satisfy  Laplace’s  equation  as  a  local-minima  free  method  for  producing  potential-field  based 
navigation  functions  in  two  dimensions.  These  functions  generate  smoother  paths  (i.e.  more  suited  to 
aircraft-like  vehicles)  than  previous  methods.  A  method  is  developed  for  constructing  analytic  stream 
functions  to  produce  arbitrary  vehicle  behaviors  while  avoiding  obstacles,  and  an  exact  solution  for  the 
case  of  a  single  uniformly  moving  obstacle  is  presented.  The  effects  of  introducing  multiple  obstacles 
are  discussed  and  current  work  in  this  direction  is  detailed.  Experimental  results  generated  on  the 
Cornell  RoboFlag  testbed  are  presented  and  discussed,  as  well  as  related  work  applying  these  methods 
to  path  planning  for  unmanned  air  vehicles. 


1  Introduction 

As  autonomous  vehicles  such  as  unmanned  air  vehicles  (UAV’s)  become  more  commonplace,  it  is  becoming 
increasingly  necessary  to  develop  methods  by  which  the  vehicles  assume  a  higher  degree  of  autonomy.  For 
example,  such  methods  would  allow  the  current  ratio  of  four  to  five  operators  for  a  single  UAV  to  be  inverted 
or  better,  with  a  few  operators  capable  of  controlling  many  vehicles.  An  experimental  scenario  we  have 
chosen  to  explore  this  issue  is  RoboFlag  [9,  10],  a  game  akin  to  “Capture  the  Flag”  in  which  one  or  two 
humans  control  a  group  of  eight  vehicles  as  they  attempt  to  capture  a  flag  in  an  opponent’s  territory  and 
return  to  their  home  base.  The  robots  must  also  avoid  being  tagged  out  by  an  opposing  team’s  robot  and 
attempt  to  prevent  the  opponent  capturing  their  own  flag,  all  while  avoiding  neutral  obstacles.  Fig.  1  depicts 
a  global  view  of  such  a  game  in  progress.  It  is  clear  from  the  situation  in  the  figure  that  low-level  control 
tasks  such  as  obstacle  avoidance  must  be  automated  in  order  for  just  one  or  two  humans  to  successfully 
play  the  game.  Furthermore,  it  would  be  very  desirable  for  the  automated  behavior  to  be  very  intuitive  in 
that  the  operators  should  not  be  surprised  by  what  paths  their  vehicles  take  given  the  commands  they  have 
issued. 

The  goal  of  the  RoboFlag  game  is  to  determine  what  technologies  will  be  required  to  enable  a  small 
number  of  humans  to  manage  a  large  number  of  autonomous  vehicles.  One  eventual  application  area  of  such 
technologies  will  be  in  the  guidance  and  control  of  UAV’s.  This  goal  complicates  the  path  planning  problem 
in  that,  in  contrast  to  car-like  vehicles  or  manipulators,  aircraft  exhibit  nonlinear  second  order  dynamics 
which  impose  requirements  such  as  minimum  speeds  and  turning  radii  that  may  not  be  easily  satisfied  by 
current  planning  methods. 

One  method  for  on-line  robot  path  planning  with  obstacle  avoidance  is  to  follow  the  (sometimes  negated) 
gradient  of  an  artificial  potential  field  which  is  constructed  such  that  the  resulting  vector  field  is  exterior 
directed  on  the  boundaries  of  the  configuration  space.  A  major  challenge  in  constructing  these  fields  is 
guaranteeing  that  a  vehicle  will  reach  the  goal  from  any  initial  position,  meaning  that  the  potential  field  has 
no  local  extrema  aside  from  the  desired  goal.  There  is  a  further  complication,  especially  apparent  in  such 
provably  correct  methods,  that  the  paths  produced  by  following  the  gradient  of  a  potential  function  may 
not  satisfy  the  second  order,  nonlinear  dynamics  of  an  aircraft-like  vehicle.  The  hydrodynamic  concept  of 
a  harmonic  stream  function  may  be  useful  with  respect  to  both  of  these  issues.  Stream  functions  (and  the 
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Figure  1:  Global  view  of  a  RoboFlag  game.  Black  vehicles,  based  on  the  left  side  of  the  field,  must  capture 
flag  (black  dot)  from  white  defense  zone  (large  white  circle)  and  return  it  to  their  home  zone  (gray  quarter 
circle)  without  being  tagged,  while  defending  their  own  flag  from  the  white  team  and  while  avoiding  neutral 
obstacles  (gray  circles). 


potential  functions  associated  with  them)  have  no  local  extrema,  and  they  generate  smoother  paths  then 
many  potential  functions  and  hence  better  nominal  paths  for  second  order  systems. 

Potential  field  and  stream  function  methods  such  as  the  one  described  here  offer  a  natural  way  in  which 
a  human  can  interface  with  a  group  of  vehicles.  Rather  than  assuming  direct  control  over  vehicle  behavior, 
a  strategy  that  limits  an  operator  to  controlling  a  single  vehicle  at  a  time,  the  human  can  shape  the  world 
that  the  vehicles  operate  in  by  tagging  various  objects  or  locations  as  obstacles,  goals,  or  other  primitives. 
These  primitives  can  then  be  (automatically)  composed  into  a  resultant  field  which  governs  vehicle  behavior 
and  which  expresses  operator  intent  while  allowing  the  vehicles  to  handle  the  low-level  control  tasks  to  which 
computers  are  particularly  well  suited.  If  the  operator  is  temporarily  taken  away  from  the  control  task,  the 
autonomous  vehicles  have  behavioral  guidelines  encoded  in  their  perceived  potential  field  that  allow  them 
to  continue  to  behave  in  a  desirable  manner. 

This  work  is  motivated  by  problems  described  in  [17]  and  [11].  The  original  concept  of  potential-field 
navigation  was  due  to  Khatib,  who  summarizes  his  approach  in  [12].  Koditschek  and  Rimon  examine  the 
topological  properties  of  navigation  functions  in  [14].  Connolly  and  Grupen  describe  the  application  of 
numerical  (finite-difference)  solutions  of  Laplace’s  equation  to  robot  navigation  in  [7].  Kim  and  Khosla 
apply  the  panel  method  of  hydrodynamic  analysis  to  develop  analytic  approximations  to  stream  functions 
for  complex  geometry  in  [13].  Akishita  et  al.  [1]  have  investigated  the  use  of  analytic  harmonic  functions 
based  on  fluid  dynamics  in  an  approach  similar  to  that  found  here.  For  a  more  exhaustive  review  of  the 
literature  on  potential  field  navigation,  particularly  with  respect  to  the  application  of  PDE  solutions  to 
path  planning,  the  reader  is  referred  to  the  introduction  to  [15].  Further  extensions  and  applications  of  the 
theory  presented  here  can  be  found  in  [3,  19].  An  alternative  approach  to  collision  avoidance  that  may  have 
complementary  applications  to  this  work  is  the  use  of  gyroscopic  forces,  introduced  in  [4]  and  discussed  with 
particular  application  to  multiple  vehicle  systems  in  [5]. 

This  paper  outlines  a  method  for  synthesizing  stream  functions  which  avoid  obstacles  while  producing 
paths  suitable  for  an  aircraft-like  vehicle.  The  contributions  of  this  paper  include  the  thorough  exploration  of 
methods  for  composing  analytic  stream  functions  and  the  explicit  treatment  of  obstacle  motion.  In  Section  2 
an  overview  of  potential  and  stream  functions  is  given  along  with  some  mathematical  preliminaries  describing 
methods  for  constructing  harmonic  functions.  An  historic  exact  result  from  hydrodynamics  for  avoiding  a 
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single  stationary  obstacle  is  given  in  Section  3  and  simulation  results  are  presented;  issues  encountered  when 
applying  this  technique  to  multiple  obstacles  are  also  described.  Section  4  describes  a  method  by  which 
obstacle  motion  can  be  incorporated  into  the  stream  function  in  an  exact  way.  This  approach,  although 
similar  to  that  of  [1],  includes  a  new  proof  of  correctness  and  is  the  primary  contribution  of  this  paper. 
Section  5  contains  a  description  of  one  implementation  of  this  method  and  experimental  results  obtained  on 
the  Cornell  RoboFlag/RoboCup  testbed  are  discussed.  A  detailed  examination  of  a  new  method  proposed 
for  modifying  the  existing  theory  to  incorporate  multiple  obstacles  exactly  is  presented  in  Section  6.  Section 
7  describes  a  few  additional  applications  of  stream  function-based  navigation  currently  being  explored  and 
discusses  possible  ties  between  this  work  and  the  gyroscopic  force  methods  presented  in  [4,  5].  Finally, 
Section  8  provides  a  summary  and  discusses  the  ongoing  theoretical  and  experimental  work  related  to  this 
method. 


2  Preliminaries 


2.1  Potential  Fields 


Potential  field  navigation  is  based  on  vehicles  following  the  (sometimes  negated)  gradient  of  an  artificial 
potential  field.  Desirable  properties  for  such  a  potential  field  are: 

(1)  Unique  global  minimum  at  goal  state. 

(2)  Gradient  is  exterior  directed  (or  tangent)  on  boundaries  of  workspace. 


(3)  Absence  of  local  extrema  corresponding  to  undesired  equilibria  in  the  resulting  vector  field. 

Property  (1)  is  not  difficult;  it  is  often  satisfied  by  having  the  field  shrink  to  — oo  at  the  goal.  Property  (2) 
ensures  obstacle  avoidance,  provided  that  the  vehicle  is  capable  of  following  the  vector  field.  Property  (3) 
guarantees  that  vehicles  will  not  come  to  rest  at  a  location  other  than  the  goal  state.  Koditschek  and  Rimon 
showed  by  topological  arguments  in  [14]  that  a  vector  field  in  a  workspace  with  in  obstacles  will  contain  at 
least  m  extra  equilibria,  and  that  through  careful  formulation  one  can  guarantee  that  these  equilibria  will 
be  saddle  points.  This  means  that  a  robot  following  the  gradient  will  reach  the  goal  state  from  any  initial 
condition  excepting  a  set  of  measure  zero  corresponding  to  the  regions  of  attraction  of  the  saddle  points. 

One  method  for  ensuring  that  an  artificial  potential  field  contains  no  local  extrema  is  to  formulate  it  as 
a  harmonic  function: 


Definition  2.1  (Harmonic  function  [2]).  A  complex- valued  function  <i>  :  W"  — >  C  which  is  continuous 
and  twice  differentiable  on  an  open,  nonempty  subset  fi  of  R"  and  which  satisfies  Laplace’s  equation, 


V2^ 


d2<t> 

dx\  + 


d2(f) 

dx22 


(1) 


is  called  a  harmonic  function  on  fi. 


The  next  theorems,  adapted  from  [2],  show  that  harmonic  functions  can  have  no  local  extrema.  Let 
B(p,r)  denote  the  open  ball  of  radius  r  centered  at  p,  and  let  B(p,r )  be  its  closure. 


Theorem  2.1  (Mean- Value  Property).  If  is  harmonic  on  B{p,r)  then  <f>(p)  equals  the  average  of  <f> 
over  B(p,r).  More  precisely, 


<t>{p) 


V (B(p,r))  JB(p,r) 


tdV. 


(2) 


Theorem  2.2  (Maximum  Principle).  Suppose  4>  is  real-valued,  and  harmonic  on  a  connected  subset,  fl  of 
R"  and  has  a  maximum  or  minimum  in  fi.  Then  f>  is  constant. 


Proof.  Suppose  <j>  attains  a  maximum  at  p  €  O.  Choose  r  >  0  such  that  B(p,r)  C  U.  If  4>(p')  <  <t>(p)  for 
some  p'  €  B(p,r),  then  the  continuity  of  f>  would  imply  that  the  average  of  <f>  over  B{p,r)  is  less  than  (f>(p), 
contradicting  Eqn.  (2).  Therefore  <f>  is  constant  on  B(p,r)  and  so  the  set  where  4>  attains  its  maximum  is 
open  in  Cl.  By  the  continuity  of  (f>,  this  set  must  also  be  closed  in  Cl.  Hence  this  set  must  be  all  of  Cl  and  <f> 
is  constant  on  U.  □ 
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The  following  corollary  follows  immediately  from  this  theorem  and  is  the  most  important  property  of 
harmonic  functions  in  the  context  of  this  work. 

Corollary  2.1.  Suppose  fl  is  bounded  and  <p  is  a  continuous,  non-constant,  real-valued  function  on  Ll  that 
is  harmonic  on  fb  Then  <p  has  no  local  extrema  in  f l. 


2.2  Complex  Functions 

The  machinery  of  complex  variables  provides  a  convenient  method  for  synthesizing  harmonic  functions 
in  two  dimensions  which  will  be  useful  in  the  following  sections.  The  following  definitions  and  theorems  are 
all  adapted  from  [16]. 

Let  z  =  x  +  iy  be  a  complex  variable  with  complex  conjugate  z  =  x  —  iy.  A  function  /  :  C  — >  C 
of  2  which  is  finite  and  single-valued  within  a  closed  contour  C  C  C  and  which  has  a  single-valued  finite 
differential  coefficient  with  respect  to  2  within  C  is  said  to  be  holomorphic.  If  the  function  f(z)  is  taken  to 
be  <p{x,y)  +  iip(x,y),  the  following  conditions  are  necessary  and  sufficient  for  f(z)  to  be  holomorphic: 

(1)  =  0  within  C. 

(2)  All  of  the  partial  derivatives  are  continuous. 

Theorem  2.3  (Cauchy-Riemann  equations).  Let  f(z)  =  <p(x,y )  +  iip(x,y)  =  <p  +  iip,  where  <p,  if  :  M2  — » 
M.  Suppose  f=  =  0.  Then 

d<t>  dip  dip  d(p 

dx  dy  dx  dy' 

These  are  known  as  the  Cauchy-Riemann  equations. 

Proof.  Note  that  x  =  \{z  +  z)  and  y  =  —  \i{z  —  z)  for  z  £  C.  Then 

df=  =  dfdx  dfdy 
dz  dx  dz  dy  dz 

13/15/ 

2  dx  2 7  dy 

1  ( d<P  ,  ■ dip\  1  -(d(p  ,dip\ 

2[d^c+td^)  +  2l[d^+%)- 

Setting  the  real  and  imaginary  components  of  this  equation  equal  to  zero  gives  the  desired  result.  □ 

The  real  and  imaginary  parts  of  a  holomorphic  function  of  2  are  called  conjugate  functions.  For  example, 
(p  and  ip  in  Theorem  2.3  above  are  conjugate  functions. 

Theorem  2.4  (Solutions  to  Laplace’s  Equation).  Conjugate  functions  are  solutions  to  Laplace’s  equa¬ 
tion. 

Proof.  The  Cauchy-Riemann  equations  give: 

d(p  dip 
dx  dy  ’ 

Differentiating  and  substituting  yields: 

d2<p  d2(p  _ 
dx 2  dy 2 

and  Laplace’s  equation  is  satisfied  by  both  cp  and  ip. 

The  preceding  theorems  show  that  we  can  construct  local  extrema-free  potential  functions  in  M2  simply 
by  taking  the  real  or  imaginary  components  of  arbitrary  holomorphic  functions  in  C.  In  the  sequel  we  will 
explore  how  to  encode  the  desired  navigation  properties  in  the  underlying  complex  function. 


dip  d(p 

dx  dy 

d2ip  d2ip 

dx2  dy2 
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2.3  Stream  Functions 


The  following  definitions  and  theorems  are  again  taken  from  [16].  Incompressible,  inviscid,  irrotational 
fluid  flow  can  be  described  in  terms  of  potential  functions  in  which  the  flow  is  always  along  the  gradient  of 
the  fluid  potential.  A  stream  function  is  a  more  general  function  which  describes  incompressible  flow  which 
may  be  viscous  and/or  rotational  in  which  the  flow  is  along  the  level  curves  of  the  function,  i.e.  the  level 
curves  are  the  streamlines  of  the  flow: 


Definition  2.2  (Stream  Function).  A  stream  function  ip  gives  the  components  u,v  of  fluid  velocity  in 
the  xy  plane  by 


u  —  — 


dip 

w 


v  = 


dip- 
dx ' 


(4) 


X/2ip  describes  the  vorticity  of  the  flow.  If  the  flow  is  irrotational  in  a  region  W,  \/2ip 
function  on  W,  and  the  potential  function  <p  exists  [16]. 


0,  ip  is  a  harmonic 


Definition  2.3  (Complex  Potential).  The  complex  potential  w  of  an  irrotational  two-dimensional  flow  of 
an  inviscid  liquid  is  defined  by 

w  =  <p  +  iip, 

where  <p  and  ip  are  the  potential  and  stream  functions  defining  the  flow.  Equating  the  velocity  components 
gives 

dip  dip  dip  dip 

dx  dy  ’  dy  dx  ’ 

which  are  exactly  the  Cauchy- Riemann  equations.  Thus  we  see  that  w  is  a  holomorphic  function  of  z  =  x+iy 
in  any  region  where  ip  and  ip  are  single- valued.  Conversely,  we  can  assume  for  w  any  holomorphic  function 
of  z  and  the  real  and  imaginary  parts  give  the  potential  and  stream  functions  for  a  possible  flow  satisfying 
Laplace’s  equation. 


The  insertion  of  an  obstacle  into  a  flow  introduces  the  boundary  condition  that  the  flow  be  tangent  to  the 
surface.  Because  ip  is  constant  along  a  streamline,  this  is  equivalent  to  the  condition  that  the  stream  function 
must  be  constant  on  an  obstacle’s  surface.  The  problem  of  enforcing  the  tangent  boundary  condition  then 
becomes  one  of  ensuring  that  the  complex  potential  has  constant  imaginary  part  on  the  obstacle  boundary. 
The  following  theorem  is  taken  from  [16]  and  adapted  for  arbitrary  obstacle  locations. 

Theorem  2.5  (Circle  Theorem).  Let  there  be  irrotational  two-dimensional  flow  of  incompressible  inviscid 
fluid  in  the  z-plane.  Let  there  be  no  rigid  boundaries  and  let  the  complex  potential  of  the  flow  be  f(z),  where 
the  singularities  of  f(z)  are  all  at  a  distance  greater  than  a  from  the  point  b.  If  a  circular  cylinder,  typified 
by  its  cross-section  the  circle  C,  \z  —  b\  =  a,  is  introduced  into  the  flow,  the  complex  potential  becomes 


w  =  ip  +  iip=  f(z)  +  f 


(5) 


Proof.  On  the  circle,  \z  —  b\  =  a.  Thus  w  reduces  to 


w  =  /  0)  +  f(z) 


which  is  purely  real  and  therefore  ip  =  0  and  C  is  a  streamline. 

The  new  complex  potential  w  is  the  sum  of  holomorphic  functions  and  thus  is  itself  holomorphic,  so  the 

2  — 

conjugate  functions  ip  and  ip  satisfy  Laplace’s  equation.  If  a  point  z  is  outside  C,  the  point  -ffzi  +  b  is  inside 
C,  and  vice-versa.  Since  all  the  singularities  of  f(z)  are  by  hypothesis  exterior  to  C,  all  the  singularities 
of  f(fzrb  +  b)  are  interior  to  C .  Thus  w  has  exactly  the  same  singularities  as  f(z)  and  all  conditions  are 
satisfied.  □ 
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3  Avoidance  of  a  Stationary  Obstacle 

The  Circle  Theorem  allows  the  stream  function  for  a  vehicle  to  be  composed  of  primitives  which  describe 
different  vehicle  behaviors.  The  most  useful  primitives  for  robot  navigation  are  the  sink,  fs(z),  and  the 
vortex,  fv(z ): 


fs(z)  =  -Cln(z),  (6) 

fv(z)  =  Ciln(z),  (7) 


where  C  £  R+  is  the  strength  of  the  singularity  associated  with  the  primitive,  which  is  assumed  without 
loss  of  generality  to  be  located  at  the  origin.  In  the  case  of  a  sink  flow  of  strength  C  into  which  a  single, 
stationary  obstacle  of  radius  a  is  placed  at  (x,y)  =  ( bx,by )  and  letting  b  =  bx  +  iby,  applying  the  Circle 
Theorem  gives  the  complex  potential 

w  =  -C  ln(*)  -  C  In 

The  imaginary  component  of  this  complex  potential  is  the  stream  function  for  the  flow 


(8) 


Note  that  on  the  surface  of  the  obstacle  ( x  —  bx )2  +  (y  —  by )2  =  a 2  and  thus  =  0,  verifying  that  the 
flow  is  tangent  to  the  surface.  Differentiating  using  the  definition  of  the  stream  function  above  yields  the 
components  u  and  v  of  the  flow  velocity, 


r 

ar  +  yz 

r  f  a2  \  bx(x  -  bx)2  +  a2(x  -  bx)  +  (y  -  by)(2byx  -  bx(y  +  bv)) 

\rV  a4  +  2a2(bx(x-bx)  +  by(y-by))  +  (b2x  +  b2y)r2  ’  U 

r  y 

x2  +  y2 

c  f  by(y  -  by)2  +  a2 (y  -  by)  +  (a;  -  bx)(2bxy  -by(x  +  bx)) 

\ro  J  a4  +  2a2(bx(x-bx)  +  by(y-by))  +  (bl  +  bl)r2 

In  practice,  the  constant  C  is  arbitrary  and  the  velocity  is  normalized  to  respect  vehicle  dynamics  while 
preserving  its  direction. 

The  object  created  upon  application  of  the  Circle  Theorem  is  called  a  doublet  and  is  essentially  the  limit 
as  a  singular  source  (defined  as  a  sink,  above,  but  with  —  C  replaced  by  C)  and  sink  are  brought  together. 
Fig.  2(a)  depicts  the  streamlines  (level  curves  of  the  stream  function)  of  a  doublet  alone.  The  important 
effect  of  this  composition  is  that,  in  contrast  to  the  objects  created  by  most  other  potential  field  methods, 
the  doublet  carries  with  it  the  notion  of  an  orientation.  The  effect  of  the  doublet  depends  not  only  on  the 
vehicle’s  position  relative  to  it,  but  also  upon  where  the  vehicle  is  going.  This  helps  to  produce  the  smooth 
paths  observed  when  using  this  method,  and  also  tends  to  produce  commands  in  the  direction  which  one 
would  intuitively  guess  to  be  “correct”  to  gently  veer  around  an  obstacle. 

Fig.  2(b)  depicts  the  streamlines  obtained  from  the  Circle  Theorem  for  a  sink  flow  with  an  obstacle. 
Note  that  the  paths  generated  by  following  the  streamlines  tend  to  be  smooth  due  to  the  tangent  boundary 
condition;  i.e.  they  appear  at  least  qualitatively  to  be  well-suited  to  the  dynamics  of  an  aircraft-like  vehicle. 
Fig.  3  compares  simulations  of  the  paths  a  fully-actuated  vehicle  with  x  =  u  dynamics  would  follow  given  a 
potential  function  following  the  formulation  of  [14]  and  one  generated  by  the  method  presented  here  for  the 
same  initial  conditions,  obstacle  location,  and  goal  position. 

All  of  the  above  statements  apply  exactly  only  to  the  case  of  a  single  obstacle.  However,  in  a  simple 
flow  such  as  a  sink  (or  source)  or  vortex  flow,  the  influence  of  an  obstacle  falls  off  with  the  square  of  the 
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(a)  Doublet  streamlines  (b)  Obstacle  avoidance 

Figure  2:  Obstacle  avoidance  streamlines. 


(a)  Potential  field  (b)  Stream  function 

Figure  3:  Comparison  of  obstacle  avoidance  approaches. 


distance  to  the  obstacle.  When  multiple  obstacles  are  present,  treating  each  obstacle  separately  by  the  above 
methods  has  been  quite  successful  in  both  simulation  and  experiment  as  long  as  the  obstacles  are  not  nearly 
touching  one  another.  Fig.  4  depicts  simulation  results  for  a  vehicle  negotiating  a  group  of  obstacles.  Work 
is  in  progress  to  determine  more  precisely  how  accurate  this  approximation  is,  and  a  method  by  which  these 
results  can  be  applied  exactly  to  the  case  of  multiple  obstacles  is  proposed  in  Section  6. 

4  Moving  Obstacles 

If  the  obstacles  to  be  avoided  are  moving,  simply  using  a  snapshot  of  the  configuration  space  at  each 
instant  in  time  to  calculate  a  quasi-static  potential  field  will  be  insufficient  to  guarantee  obstacle  avoidance. 
This  can  be  seen  by  imagining  that  the  vehicle  is  infinitesimally  close  to  the  leading  edge  of  a  moving  obstacle 
at  a  particular  instant.  A  navigation  function  is  guaranteed  to  be  exterior  directed  (or  at  least  tangent,  in  the 
case  of  stream  functions)  on  the  boundary,  but  does  not  guarantee  that  it  will  produce  a  vehicle  motion  which 
will  be  fast  enough  (ignoring  actuator  constraints)  to  stay  ahead  of  the  obstacle.  Furthermore,  a  quasi-static 
potential  function  may  also  generate  undesirable  behavior  even  if  obstacle  avoidance  is  successful  in  that  it 
may  direct  a  vehicle  to  pass  in  front  of  an  obstacle  rather  than  behind  it.  Both  of  these  issues  can  be  dealt 
with  by  a  change  of  reference  frame  in  which  the  condition  for  obstacle  avoidance  becomes  that  the  vector 
field  must  be  exterior  (or  tangent)  directed  on  the  boundary  of  the  obstacle  in  the  rest  frame  of  the  obstacle. 
Stream  functions  offer  a  convenient  method  for  handling  this  condition. 

Theorem  4.1  (Stream  Function  for  a  Moving  Obstacle).  Consider  a  circular  obstacle  in  an  arbitrary 
irrotational  two-dimensional  flow  of  incompressible  inviscid  fluid  with  complex  potential  f(z)  as  in  the  Circle 
Theorem  above.  Let  the  obstacle  be  moving  at  constant  velocity  vq  =  vx  +  ivy.  The  complex  potential  for  the 
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Figure  4:  Multiple  obstacle  avoidance. 


flow  about  the  obstacle  is  given  by 

~iVy  {^~b+^)  ’  (10) 

where  ws  is  the  static  stream  function  that  would  be  derived  if  the  obstacle  were  not  moving. 

Proof.  Performing  a  Galilean  transformation  into  the  reference  frame  of  the  obstacle  superimposes  —vq  on 
the  velocity  field  given  by  w(z).  The  complex  potential  for  this  uniform  flow  is  g(z)  =  —vxz  +  ivyz,  so  the 
complex  potential  described  by  Eqn.  (10)  in  this  reference  frame  is  given  by 

w'{z)  =  ws(z)  —  vxz  +  iv.yZ 

-ivy 

=  /W  +  /(j^+5) 

+  9(2)  +  5(jV6  +  '1)' 

which  is  the  result  given  by  applying  the  Circle  Theorem  to  the  flow  in  the  rest  frame  of  the  obstacle.  Thus 
the  vector  field  is  tangent  to  the  obstacle  boundary  in  the  reference  frame  of  the  obstacle  and  a  vehicle 
following  the  vector  field  will  not  hit  the  obstacle.  □ 

The  result  of  the  above  theorem  is  to  add  an  additional  doublet  which  describes  how  the  vehicle  should 
pass  around  the  moving  obstacle.  Note  that  in  contrast  to  the  sink  strength  discussed  above,  the  strength  of 
this  doublet  is  not  arbitrary;  it  is  that  required  to  avoid  the  moving  obstacle  and  it  is  set  by  the  magnitude 
of  the  obstacle’s  velocity. 

Fig.  5  depicts  simulation  results  for  goal  seeking  with  and  without  the  additional  dynamic  component  of 
the  stream  function  in  place.  The  vehicle  is  depicted  as  a  series  of  outlined  circles  representing  equal  time 
steps,  and  the  obstacle  is  depicted  as  solid  circles  at  the  same  set  of  times.  The  obstacle  is  moving  on  a 
circular  trajectory  at  a  constant  speed  equal  to  the  maximum  speed  of  the  vehicle.  In  Fig.  5(a)  the  vehicle 
attempts  unsuccessfully  to  pass  in  front  of  the  obstacle  and  a  collision  takes  place.  In  Fig.  5(b),  the  vehicle 
successfully  avoids  the  obstacle  by  passing  behind  it. 

5  Experimental  Results 

Stream  function-based  navigation  has  been  implemented  on  Cornell  University’s  RoboFlag/RoboCup 
testbed  [9],  shown  in  Fig.  6.  The  RoboFlag  vehicles  are  omni-directional  and  capable  of  following  nearly 
arbitrary  trajectories,  and  so  are  an  ideal  testbed  for  the  initial  implementation  of  these  concepts.  Further¬ 
more,  the  input  to  the  low-level  controllers  on  the  vehicles  is  the  desired  velocity,  so  stream  functions  are 
particularly  suited  to  generating  the  control  inputs. 
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w(z)  =  ws(z)  -  vx 
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(b)  With  dynamic  component 


Figure  5:  Moving  obstacle  avoidance.  Vehicle  (open  circle)  attempts  to  travel  to  destination  marked  ‘x’ 
while  avoiding  moving  obstacle  (shaded  circle).  Obstacle  follows  a  set  circular  trajectory. 


Figure  6:  RoboFlag  testbed. 


The  current  experimental  implementation  requires  the  velocity  obtained  from  the  stream  function  to  be 
normalized  to  suit  the  dynamics  of  the  vehicle  as  well  as  the  desired  speed  range.  In  the  case  of  static 
obstacle  avoidance,  the  simple  dynamics  of  the  RoboFlag  vehicles  allows  them  to  travel  at  nearly  their 
maximum  speed  all  of  the  time,  so  the  normalization  simply  retained  the  direction  of  the  stream  function- 
commanded  velocity  and  set  the  velocity  to  this  maximum.  When  the  obstacles  were  moving,  however,  a 
different  approach  was  necessary.  The  equations  from  Section  4  separate  into  two  independent  components: 
one  due  to  the  external  flow  and  static  obstacle  configuration,  and  one  due  to  the  motion  of  the  obstacle. 
As  discussed  above,  the  magnitude  of  the  velocity  due  to  the  static  configuration  and  goal  is  arbitrary 
prior  to  normalization,  but  the  magnitude  of  the  velocity  due  to  the  obstacle  motion  has  physical  meaning. 
Hence,  when  normalizing  commands  to  satisfy  actuator  constraints,  the  dynamic  component  was  entirely 
satisfied  and  any  remaining  actuator  authority  was  devoted  to  the  static  component.  Obstacle  avoidance 
was  guaranteed  because  the  external  flow  was  given  the  maximum  strength  possible  that  would  allow  the 
vehicle  to  preserve  the  intended  direction  of  travel.  That  is,  the  normalization  was  given  by  maximizing  the 
sink  strength  C  with  the  constraints 
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where  vs  and  Vd  are  the  static  and  dynamic  velocity  components  and  umax  and  amax  are  the  maximum  speed 
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Figure  7:  Multiple  obstacle  avoidance  -  RoboFlag  experimental  results.  Vehicle  (open  circles)  travels  from 
home  zone  in  top  left  of  figure  to  capture  flag  (black  dot)  in  opponents  flag  zone  while  avoiding  stationary 
obstacles  (filled  circles).  Time  span  is  approximately  10s,  with  0.3s  between  frames. 


and  acceleration  constraints  on  vehicle  motion. 

Several  maneuvers  were  performed  at  a  maximum  speed  of  0.6  m/s.  The  first  maneuver  was  a  “capture  the 
flag”  exercise.  Using  sink  stream  functions,  the  vehicle  was  commanded  to  start  out  at  a  home  location,  travel 
about  4  meters  to  a  point  and  stop  there,  then  return  to  the  initial  location,  all  while  avoiding  stationary 
obstacles  placed  randomly  on  the  field.  The  vehicle  was  consistently  able  to  perform  this  maneuver  without 
coming  into  contact  with  the  obstacles  as  long  as  the  obstacle  configuration  was  relatively  sparse,  e.g.  about 
four  obstacles  in  the  path  from  home  to  goal.  Fig.  7  depicts  one  such  test  run  spanning  10  seconds.  During 
this  run  the  proposed  correction  to  make  multiple  obstacle  avoidance  exact  described  in  Section  6  was  in 
place. 

The  second  maneuver  tested  was  an  orbit/defend  maneuver.  The  vehicle  was  commanded  to  circle  a 
particular  point  at  a  1-meter  radius.  Control  of  the  radius  was  implemented  via  source/sink  flows  at  the 
orbit  center,  and  the  orbit  itself  was  implemented  using  a  vortex.  Obstacle  avoidance  was  again  demonstrated 
in  this  maneuver.  Multiple  vehicles  were  able  to  perform  this  maneuver  together,  spacing  themselves  equally 
about  the  circle  by  monitoring  the  positions  of  the  other  vehicles  and  adjusting  their  own  maximum  speed 
to  compensate. 

The  third  maneuver  tested  was  avoidance  of  moving  obstacles.  Three  vehicles  were  commanded  to  circle 
the  destination  of  a  flag-capturing  robot  without  avoiding  obstacles.  The  “capture  the  flag”  maneuver  was 
then  run  both  with  and  without  the  dynamic  component  of  the  stream  function  present.  Performance 
without  the  dynamic  component  was  very  poor  -  -  unless  the  vehicle  happened  to  be  approaching  the  goal 
at  exactly  the  right  time,  it  would  collide  with  one  of  the  passively  moving  “defenders,”  often  because  the 
static  stream  function  commanded  it  to  try  to  pass  in  front  of  the  moving  obstacle.  The  introduction  of 
the  dynamic  stream  function  (normalized  using  Eqn.  (11))  improved  performance  dramatically.  With  this 
component  in  place,  the  attacker  could  generally  capture  the  flag  and  return  without  collision,  following  a 
path  that  would  take  it  behind  a  defender  when  necessary  rather  than  trying  to  hook  around  in  front. 

In  all  demonstrations  the  effects  of  having  multiple  rather  than  a  single  obstacle  seemed  to  be  negligible 
as  long  as  the  obstacles  were  at  least  one  obstacle  diameter  apart.  Demonstrations  of  all  maneuvers  in 
simulation  were  much  more  successful  at  dealing  with  higher  obstacle  densities;  high  latency  in  the  system 
(on  the  order  of  500  ms)  was  the  likely  cause  for  this  discrepancy.  Movies  of  the  experiments  described  above 
are  available  online  at  http://www.cds.caltech.edu/~waydo/streainmovies/streammovies.html 
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6  Extension  to  Multiple  Obstacles 

The  current  focus  of  this  work  is  to  improve  the  treatment  of  multiple  obstacles.  Attempts  to  solve 
Laplace’s  equation  analytically  with  the  multiple  obstacle  boundary  condition  have  not  been  fruitful,  but 
another  approach  which  involves  interpolating  between  the  single-obstacle  cases  may  be  of  use  in  the  most 
important  case,  that  of  a  goal-seeking  (sink)  flow.  First  it  is  necessary  to  re-examine  the  velocity  field  in  a 
sink  flow  with  obstacle  in  a  bit  more  detail. 

The  x  and  y  components  u  and  v  of  the  flow  velocity  are  given  by  Eqn.  (9).  Assume  without  loss  of 
generality  that  C  =  1.  Let  r0  be  the  distance  from  the  point  (x,y)  to  the  center  of  an  obstacle  located  at 
(bx,  by),  i.e.  r2  =  (x  —  bx )2  +  (y  —  by )2  and  let  a  be  the  obstacle  radius. 

Lemma  6.1.  The  velocity  field  resulting  from  a  circular  obstacle  being  placed  in  a  sink  flow  always  has  a 
non-zero  component  directed  toward  the  origin  outside  the  obstacle  (i.e.  when  r0  >  a). 

Proof.  The  component  of  the  velocity  field  due  to  the  sink  is  always  directed  toward  the  origin  and  has 
magnitude  ( x 2  +j/2)_5.  Hence,  it  is  sufficient  to  show  that  the  magnitude  of  the  velocity  due  to  the  doublet 
is  always  smaller  than  this  when  r0  >  a. 

Because  of  symmetry  we  can  set  by  =  0  and  bx  >  0  without  loss  of  generality  (Note  that  because 
the  obstacle  may  not  overlap  the  goal  point,  bx  >  a).  With  this  substitution  and  after  some  algebra  the 
magnitude  of  the  velocity  due  to  the  doublet  becomes 


Since  a/rQ  <  1  outside  the  obstacle  it  is  now  sufficient  to  show  that  a 2  +  b2(r0/a)2  +  2xbx  —  2 b2  >  x2  +  y2 . 
We  do  so  by  contradiction. 


a 


2 


<  x2  +  y2 

<  x2  —  2  xbx  +  b2+y2 


<  1, 


which  violates  the  condition  that  a/r0  <  1.  □ 

This  fact  allows  us  to  interpolate  between  the  single  obstacle  cases  without  generating  new  equilibria. 
Let  the  configuration  space  contain  m  obstacles,  with  the  ith  obstacle,  i  =  1, . . .  ,m,  having  radius  cq  and 
location  (bXi,bVi).  Let  tq  and  ly  denote  the  x  and  y  velocity  components  that  would  exist  for  a  sink  flow 
about  obstacle  i  on  its  own.  Define  m  distance  functions  di  :  R2  — >  R, 

di  =  (x2  ~  b2Xif  +  (y2-bli)2  -  oj, 

which  is  the  distance  from  the  point  (x,y)  to  the  boundary  of  the  ith  obstacle.  Finally,  define  interpolation 
functions  on  the  df  s  as  cq  :  Rm  — >  [0, 1]  with  the  following  constraints: 

cq  =  0  when  dj  =  0  V  j  ^  i 

at  =  1  when  di  =  0  (12) 

cq  €  (0, 1)  when  dk  >  0  V  k, 
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where  i,j,k£  [1, 2, . . . ,  to].  One  such  function  is 


n 


d  ,  -\-  d  .j 


The  proposed  form  of  the  final  velocity  field  is 


l 


=  £ 


CXiVi. 


(13) 


This  interpolation  guarantees  that  on  an  obstacle  surface  the  vector  field  will  be  exactly  that  which  would 
have  existed  in  the  presence  of  that  obstacle  alone;  thus  it  guarantees  obstacle  avoidance  as  above.  Because 
it  is  no  longer  the  gradient  of  a  harmonic  function,  the  velocity  field  is  no  longer  guaranteed  by  the  previous 
proofs  to  have  no  spurious  equilibria  and  a  new  proof  is  required. 

Theorem  6.1.  Composing  stream-function-based  velocity  fields  using  Eqns.  (12)  and  (13)  will  create  no  new 
equilibria. 

Proof.  Decompose  the  velocity  field  induced  by  each  obstacle  into  radial  and  tangential  components,  (uj,  Vi)  i— > 
( vri,vgi ).  The  total  velocity  field  is  then 


vr 


'y  )  OiiVri ,  Vg 
i 


y '  onvoi . 

i 


By  the  lemma,  vri  <  0  for  all  i  away  from  the  surface  of  any  obstacle,  and  so  because  on  >  0  for  all  i  the 
total  radial  velocity  vr  <  0.  Thus  the  total  velocity  \Jvf.  +  Vg  yf  0  away  from  the  obstacles  and  the  field  has 
no  local  equilibria.  On  the  surface  of  an  obstacle,  the  velocity  field  is  exactly  that  given  by  the  obstacle  in 
the  sink  flow  alone,  and  so  any  equilibrium  on  the  surface  must  be  a  saddle  point  as  before.  □ 


7  Other  Applications  and  Ongoing  Work 

In  [19],  methods  for  using  stream  functions  to  generate  more  complex  trajectories  and  behaviors  than 
those  presented  here  are  discussed.  This  work  also  examines  several  new  methods  for  accommodating 
workspaces  with  multiple  obstacles,  with  the  goal  of  safely  navigating  an  unmanned  aircraft  through  hostile 
territory.  For  this  application  the  “obstacles”  are  generally  spheres  of  influence  of  enemy  antiaircraft  instal¬ 
lations.  One  interesting  aspect  of  this  work  is  that  there  may  not  exist  a  path  to  the  destination  that  fully 
avoids  all  of  these  obstacles,  and  dynamic  resizing  of  the  perceived  obstacles  (which  are  then  known  as  “soft 
obstacles”)  is  used  to  open  paths  while  attempting  to  minimize  exposure  to  danger.  Fig.  8  depicts  a  simula¬ 
tion  of  a  UAV  navigating  through  hostile  territory  using  a  stream  function  planner  and  incorporating  these 
techniques.  The  dashed  circles  represent  zones  of  influence  of  enemy  threats.  Note  that  in  this  case  there 
is  no  totally  clear  path  between  the  starting  an  final  conditions,  but  the  use  of  the  soft  obstacle  techniques 
mentioned  above  enables  the  UAV  to  reach  its  destination  while  minimizing  the  time  spent  in  dangerous 
regions.  A  single  waypoint  is  also  used  in  this  simulation  to  guide  the  vehicle’s  progress;  the  kink  visible  in 
the  path  is  the  point  at  which  the  destination  is  suddenly  switched. 

This  work  also  examines  the  use  of  simulated  spring  forces  between  vehicles  as  a  means  of  maintaining 
formation  while  using  a  stream  function  as  a  path  planner.  Two  approaches  are  discussed:  that  of  a  leader 
aircraft  following  a  stream  function  while  the  follower  aircraft  maintain  formation,  and  one  in  which  each 
aircraft  independently  follows  a  stream  function  to  its  desired  goal  while  also  feeling  the  effect  of  spring 
forces  that  maintain  group  cohesion. 

Another  obstacle  avoidance  methodology  that  may  have  important  connections  to  this  work  is  the  use  of 
gyroscopic  forces.  Gyroscopic  forces  can  be  thought  of  as  steering  forces,  as  they  always  act  perpendicular  to 
the  velocity  vector.  Obstacle  avoidance  is  not  implemented  using  a  vector  field  in  this  case,  so  the  topological 
difficulties  described  by  Koditshek  and  Rimon  in  [14]  can  be  circumvented.  The  use  of  such  forces  for  obstacle 
avoidance  is  introduced  in  [4]  and  examined  in  the  context  of  multiple  vehicle  systems  in  [5].  In  both  of 
these  papers  a  potential  function  is  used  to  induce  goal-seeking  behavior  while  the  gyroscopic  forces  are 
used  for  obstacle  avoidance.  Because  of  this  formulation,  it  may  be  possible  to  use  stream  functions  and 
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Figure  8:  Simulation  of  a  UAV  carrying  out  a  mission  using  stream  function  path  planning.  Vehicle  navigates 
from  position  marked  “start”  to  position  marked  “goal.”  while  attempting  to  avoid  threat  zones  (dashed 
circles).  Threat  zones  are  treated  as  “soft”  obstacles  to  open  a  path  for  the  vehicle. 


gyroscopic  forces  simultaneously  in  a  complementary  way.  A  stream  function  could  be  used  as  a  high-level 
path  planner  used  to  generate  a  smooth  path  from  start  to  goal  that  avoids  dangerous  regions,  as  in  [19], 
and  then  gyroscopic  forces  superimposed  to  handle  lower-level  obstacle  avoidance.  It  appears  that  it  will 
be  easier  to  explicitly  address  non-trivial  vehicle  dynamics  within  the  gyroscopic  force  framework,  and  so 
passing  the  low-level  obstacle  avoidance  down  to  a  gyroscopic  force  algorithm  may  be  a  convenient  method 
to  address  this  issue.  Such  a  hierarchical  framework  may  also  have  applications  in  control  of  multiple  vehicle 
systems,  in  which  a  stream  function  could  be  used  to  generate  the  potential  that  each  vehicle  in  the  group 
follows  while  inter- vehicle  collisions  are  prevented  by  gyroscopic  forces. 


8  Summary  and  Future  Work 

This  paper  has  presented  a  method  for  composing  local-extrema  free  potential  fields  for  vehicle  guidance 
using  stream  functions.  These  functions  provide  avoidance  of  moving  obstacles  while  allowing  flexibility  in 
designing  the  overarching  vehicle  behavior.  While  the  results  presented  above  apply  exactly  only  to  the  case 
of  a  single  obstacle,  a  promising  method  for  treating  multiple  obstacles  exactly  has  been  found.  Future  work 
will  focus  on  several  key  areas  outlined  below. 

An  important  extension  needed  to  fully  exploit  the  possible  applications  of  stream  functions  will  be  that 
to  a  three-dimensional  workspace.  The  complex  potential  approach  is  inherently  two-dimensional  and  will 
not  extend  readily  to  this  case.  Two  possibilities  arise  here.  It  may  be  that  suitable  three-dimensional 
problems  can  be  posed  as  multiple  lower-dimensional  problems  to  be  solved  simultaneously.  For  example, 
altitude  control  of  an  aircraft  may  be  performed  as  a  separate  function  from  navigation  in  the  plane  and  the 
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planar  navigation  problem  solved  via  the  above  methods.  Also,  because  complex  functions  are  only  used  as 
part  of  the  synthesis  and  analysis  problems  and  do  not  show  up  in  the  final  stream  function,  there  may  be 
extensions  of  the  above  results  to  three  dimensions  obtainable  without  the  complex  variables  machinery. 

While  the  paths  generated  by  the  stream  function  method  appear  more  likely  to  be  suited  to  vehicles  such 
as  aircraft  than  those  produced  by  other  means,  there  is  no  explicit  consideration  of  vehicle  dynamics  in  the 
above  formulations.  The  guarantees  of  obstacle  avoidance  rest  on  the  assumption  that  the  vehicle  follows 
exactly  the  streamlines  of  the  flow.  Other  methods,  for  example  that  followed  by  Koditschek  and  Rimon  in 
[14],  do  provide  guaranteed  obstacle  avoidance  for  actuator-limited  vehicles  by  bounding  the  system  energy 
(including  that  of  the  artificial  potential) .  Such  proofs,  however,  rely  on  the  vehicle’s  ability  to  produce  force 
in  any  direction  and  the  resulting  trajectories  may  not  be  feasible  for  aircraft-like  vehicles.  Another  area  for 
future  research  is  to  develop  a  quantitative  understanding  of  the  motion  described  by  stream  functions  and 
how  vehicle  dynamics  including  under-actuation  and  minimum  speed  requirements  might  be  incorporated 
into  synthesis. 

In  addition  to  the  above  questions  regarding  the  current  theory,  future  work  will  focus  on  handling 
multiple  vehicle  formations  in  the  stream  function  framework.  It  may  be  that  “flexible”  formation  flight  and 
obstacle  avoidance  can  be  incorporated  together  by  having  vehicles  act  as  if  they  are  part  of  a  viscous  “blob” 
suspended  in  an  inviscid  fluid;  this  may  be  an  adaptation  of  the  virtual  leader  method  as  in  [18].  It  is  hoped 
that  this  type  of  approach  will  naturally  lead  to  formations  that  adapt  themselves  to  the  environment;  for 
example,  a  circular  formation  may  become  longer  and  narrower  as  it  passes  between  obstacles.  The  approach 
explored  in  [19]  in  which  each  vehicle  follows  a  stream  function  while  also  feeling  a  spring  force  maintaining 
formation  appears  to  be  a  start  along  these  lines. 

The  use  of  gyroscopic  forces  as  discussed  above  may  prove  to  be  complementary  to  this  method  and 
could  help  to  resolve  some  of  the  issues  raised  here,  specifically  explicit  consideration  of  vehicle  dynamics 
and  control  of  groups  of  vehicles.  Another  important  area  of  future  work  is  to  examine  in  detail  possible 
ways  to  integrate  the  work  described  here  with  the  gyroscopic  force  formulation. 

Several  experimental  thrusts  are  planned  for  the  near  future  as  well.  The  current  obstacle  avoidance 
libraries  available  for  use  on  the  RoboFlag  testbed  include  stream  functions  as  an  option,  so  any  future 
experiments  on  the  testbed  can  also  be  used  to  further  explore  stream  functions.  Longer  term  testing  plans 
include  implementing  stream  function-based  control  on  the  Caltech  Multi- Vehicle  Wireless  Testbed  (MVWT) 
[6,  8].  The  vehicles  associated  with  this  testbed  rest  on  omni-directional  casters  and  are  powered  by  two 
fixed  ducted  fans;  thus,  they  have  the  aircraft-like  dynamics  that  this  theory  was  developed  to  address. 
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